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@ Vorrichtung zur Ermittlung fahrspurverlaufsindikativer Daten 

(§7) Die Erfindung bezieht sich auf eine Vorrichtung zur Er- 
mittlung von fur den Verlauf einer Fahrspur indikativen 
Daten, die eine Fahrspurerkennungssensorik, eine Ob- 
jektpositionssensorik, die wenigstens den Abstand eines 
vor dem Fahrzeug befindlichen Objektes und dessen 
Richtungswinkel bezuglich der Fahrzeugbewegungsrich- 
tung erfafct, und eine Fahrzeugeigenbewegungssensorik 
beinhaltet. 

Erfindungsgemafc ist eine Schatzeinrichtung vorgesehen, 
der die Fahrspurerkennungsmeftdaten, die Objektpositi- 
onsmeftdaten und die FahrzeugeigenbewegungsmeRda- 
ten zugefuhrt werden und die in Abhangigkeit davon die 
Fahrspurkrummung und/oder die Querposition eines je- 
weiligen Objektes vor dem Fahrzeug relativ zur Fahrspur 
durch Schatzung mittels eines vorgebbaren, ein dyna mi- 
series FahrzeugbewegungsmodeJI beinhaltenden Schatz- 
algorithmus ermittelt. Vorzugsweise beinhaltet die Vor- 
richtung hierzu ein Kal man-Filter. 
. Verwendung z. B. in Strafcenfahrzeugen. 
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Beschreibung 

Die Erfindung bezieht sich auf eine Vorrichtung zur Er- 
mitt.lung von fur den Verlauf einer Fahrspur, beispielsweise 
einer StraBe, indikaliven Daren nachdem Oberbegriff des 
Anspruchs 1. (DE41 33 882 Al) 

Dicsc Vorrichtung bcinhaltet zum einen eine den Fahr- 
spurhorcich vor deni Fahrzeug erfassende Fahrspurerken- 
nungssensorik. wclchc FahrspurerkennungsmeBdaten z. B. 
in Form von Fahrspur ma rkierungskoordinaten iiefert. Der- 
ail igc Scnsorikcn si ml beispielsweise als optische Spurer- 
kenmm^scinrichlungcn bckannt, die ein Bildaufnahmesy- 
steni und cin nuchgesch alleles Bildverarbeitungs system be- 
inhalien. wie in don Palonischriften DE43 32 836 CI und 
EPO 446 903 HI sowie der Offenlegungsschrift 
DE42 2I 015 A I olTenburi. Sie werden insbesondere zur 
selbstiatigen Sicucrung tier Langs- und/oder der Querbewe- 
gung von l'ahrzcugen im Rahmcn einer Abstandsrcgclcin- 
richtung uruiAxlor eines auiomatischen Fahrzeuglenksy- 
stems verwendct. Die maximale Entfernung, in der Fahr- 
spurmarkierungen von einer solchen Sensorik noch zuver- 
lassig deleklicrt werden konnen, d. h. deren Sichtweite, ist 
aufgrund mehrcrcr Fakioren beschrankt, wie der Einbau- 
hohe einer zugehdrigen Videokamera im Fahrzeug, den Wit- 
Lerungsbedingungen, der TageszeiU dem Verschmulzungs- 
grad der Fahrspur usw. Bei zu geringer Sichtweite ist eine 
autononic Fahrzeug fuhrung allein mit diesen Mitteln nicht 
mehr zuverlassig moglich. Auch reine Abstandsregelein- 
richtungen benoiigen den Fahrspurverlauf in groBerer Ent- 
fernung, z. B. bis mindesicns ei.wa 150 m, mit ausreichend 
hoher Genauigkeil. Eine Extrapolation des Fahrspurverlaufs 
in dieser Entfernung aus dem durch rein optische Spurer- 
kennung im Nahbereich erkannten Verlauf erweist sich zu- 
mindest bei geringer Sichtweite als nicht zufriedenstellend. 

Zum anderen beinhaltet die Vorrichtung auBerdem eine 
Objektpositionssensorik, welche wenigstens den Abstand 
eines vor dem Fahrzeug befindlichen Objektes, z. B. ein 
vorausfahrendes Fahrzeug oder ein stationar am Fahrspur- 
rand befindliches Objekt, sowie den Winkel erfaBt, in wel- 
chem dieses Objekt bezuglieh der eigenen Fahrzeugbewe- 
gungsrichtung erscheint. Solche Sensoriken werden insbe- 
sondere in Abstandsregeleinrichtungen eingesetzt, um einen 
kon stan ten Abstand zu einem vorausfahrenden Fahrzeug 
einzuhalten. Die hier verwendeten Techniken, wie Ab- 
standserfassung mittels Laser- oder Radarstrahl, haben den 
Vorteil, dafi sie auch bei geringerer optischer Sichtweite 
noch fur groBere Entfernungen zuverlassige MeBresultate 
liefem, jedoch erlauben diese MeBdaten allein keine Be- 
stimmung des Fahrbahnverlaufs. 

Es wurden bereits Vorrichtungen der eingangs genannten 
Art vorgeschlagen, bei denen eine auf Radar basierende Ob- 
jektpositionssensorik zur Erkennung vorausfahrender Fahr- 
zeuge und als Unterstutzung dieses Fahrzeugverfolgungsra- 
dars ein oplisches Bildaufnahme- und Bildverarbeitungssy- 
stem vorgesehen ist, um die Position von Objekten vor dem 
eigenen Fahrzeug als Hilfestellung zum Radarsystem zu 
schatzen. Wenn jedoch beispielsweise wegen schlechter 
Sicht das optische System keine zuverlassigen Positionsda- 
ten Iiefert, reduziert sich die Leistungsfahigkeit des (Jesamt- 
systems wiederum auf diejenige des Radarsy stems. 

Es ist an sich bekannt, in Fahrzeuganwendungen zur Be- 
rechnung besummter fahrzeugbezogener GroBen, z. B. des 
Schwimmwinkels und anderer FahrdynamikgroBen, Schatz- 
einrichtungen in Form sogenannter Beobachter oder Kal- 
man-Filtcr cinzusctzen. Beziiglieh dieses Einsatzcs von 
Schatz- bzw. Beobachterkonzepten in Fahrzeugsystemen sei 
z. B. auf die Offenlegungsschrift DE 196 07 429 Al und die 
dort zitierte Literatur verwiesen. 
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In der nachverofTentlichten Offenlegungsschrift 
DE 197 20 764 Al ist. ein Verfahren zur Erkennung des vor- 
ausliegenden Fahrbahnverlaufs fur ein Kraftfahrzeug be- 
schrieben, bei dem die Eigengeschwindigkeit. erfaRt sowie 
5 durch Radarsensorik die Position und Geschwindigkeit vor- 
ausbefindlicher Objekte ermittelt werden. Aus von der Ra- 
darsensorik erkannten Festzielen entlang des Fahrbahnran- 
des werden durch Sen well wertvergleicb von Zielampiituden 
die fahrbahnrandspezifischen Ziele in diskreten Winkelbe- 

10 reichen separiert, worauf in jedem Winkelbereich durch 
Ordnungsfilterung der Zielentfemungen die aktuellen Fahr- 
bahnranddistanzen zum Fahrzeug bestimmt werden, die 
dann als Merkmale zur adaptiven Pradiktion des Kurventyps 
mit einem Klassifikator und als Stutzstellen fur eine Kur- 

15 venregression verwendet werden. Zur Glattung der Fahr- 
bahnranddistanzen kann ein modellbasiertes Kalmanfilter 
eingesetzt werden, dessen Modell auf Vorabwissen liber die 
Dynamik von StraBcnvcrlaufcn bcruht. Der pradizicrende 
Kurvenklassifikator kann durch ein neuronales Netz gebil- 

20 detsein. 

In der nachveroffentlichten Offenlegungsschrift 
DE 197 49 545 Al ist eine Objekterfassungseinrichtung fiir 
ein Kraftfahrzeug mit wenigstens einer Abstandssensorein- 
richtung fiir die Ausstrahlung von MeBstrahlen in unter- 

25 sehiedliche Richtungen bezogen auf einen SysteiiimiUen- 
strahl und fur den Empfang von objektreflektierten MeB- 
strahlen und mit einer Auswerteeinheit, in der die empfan- 
genen MeBstrahlen hinsichtlich einer Objektrichtung und ei- 
nes Objektabstandes einem detektierten Objekt zugeordnet 

30 werden, beschrieben, wobei der Abstandssensoreinrichtung 
eine Bewertungseinrichtung nachgeschaltet ist, an die eine 
Gebereinheit fur Informationen iiber die aktuelle StraBen- 
geometrie der befahrenen StraBe angeschlossen ist und die 
in Abhangigkeit der StraBengeometrie die empfangenen 

35 MeBsignale bewertet. Die Objekterfassungseinrichtung 
dient insbesondere zur Erkennung von vor dem Fahrzeug 
befindlichen Objekten im Rahmen einer Abstandsregelung 
oder einer Abstandswarneinrichtung. 

In der nachveroffentlichten Offenlegungsschrift 

40 DE 197 43 726 Al ist ein Fahrzeugsteuergerat mit einer Po- 
sitionsdatenerfassungseinrichtung zum Erfassen der Positi- 
onsdaten eines vorausfahrenden Fahrzeugs, einer Bildauf- 
nahmeeinrichtung zum Aufhehmen eines nach vorn in einer 
Fahrtrichtung des Fahrzeugs gerichteten Bilds, einer Fahr- 

45 betriebsdatenerfassungseinrichtung zum Erfassen von Fahr- 
betriebsdaten des vorausfahrenden Fahrzeugs anhand des 
Bilds und mit einer Steuereinrichtung zum Durchfuhren ei- 
ner vorbestimmten Steuerung aufgrund Lage der Positions- 
daten und der Fahrbetriebsdaten des vorausfahrenden Fahr- 

50 zeugs beschrieben. AuBerdem wird die Fahrzeugeigenbewe- 
gung mittels eines Lenkwinkelsensors und eines Fahrzeug- 
geschwindigkeitssensors erfaBt. 

In der Offenlegungsschrift DE41 33 882 A 1 ist ein Ver- 
fahren zum selbsttatigen Nachfiihren eines Fahrzeugs auf 

55 der Spur eines vorausfahrenden Fuhrungsfahrzeugs orTen- 
bart, bei dem mittels einer elektronischen Kamera laufend 
Bildsignale fur signifikante Heckbereiche des Fuhrungs- 
fahrzeugs erzeugt und daraus durch elektronische Bildaus- 
wertung der in Fahrzeuglangsrichtung gemessene Abstand 

60 zwischen dem eigenen und dem Fuhrungsfahrzeug sowie 
der Seitenversatz des Fuhrungsfahrzeugs gegenuber der 
Langsachse des eigenen Fahrzeugs ermittelt und nach einer 
vorgegebenen mathematischen Beziehung erforderliche 
Lenkwinkelwerte fiir die Nachfuhrung errechnet werden. 

65 Der Erfindung licgt als tcchnischcs Problem die Bercit- 
stellung einer Vorrichtung der eingangs genannten Art zu- 
grunde, mit der vergleichsweise zuverlassig fahrspurver- 
lauf si ndikative Daten in Echtzeit auch bei ungunstigen Um- 
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gebungsbedingungen erhalten werden konnen und die ins- 
besondere eine zuverlassige Erfassung der Fahrspurkriim- 
mung und/oder der Querposition von Objekten vor dem 
Fahrzeug hezogen auf die Fahrspur ermoglicht. 

Die Erfindung Lost dieses Problem durch die Bereitstel- 
lung einer Vorrichtung mit den Merkmalen des Anspruchs 1 . 
Diese Vorrichtung beinhaltet eine Schatzeinrichtung, der die 
FahrspurerkennungsmeBdaten von der optischen Fahrspur- 
erkennungssensorik und die ObjektpositionsmeBdaten der 
Objektpositionssensorik zugefuhrt werden und die in Ab- 
hangigkeit von diesen MeBdaten die Fahrspurkrummung 
und/oder die Position des jeweils erkannten Objektes vor 
dem Fahrzeug relativ zur Fahrspur durch Schatzung unter 
Verwendung eines vorgebbaren, ein dynamisches Fahrzeug- 
bewegungsmodeil beinhaitenden Schatzalgorithmus ermit- 
telt. Die Schatzeinrichtung kann insbesondere ein sogenann- 
ter Beobachter oder ein Kalman-Filter sein. Da in die 
Schatzeinrichtung die Ausgangssignalc sowohl der Fahr- 
spurerkennungssensorik als auch der Objektpositionssenso- 
rik eingehen, wird dort eine nichttriviale Fusion beider Sen- 
sorfunktionalitaten durch den Schatzalgorithmus erreicht, 
die zur Folge hat, daB selbst bei zeitweiligem Ausfall der ei- 
nen oder der anderen Sensorik noch eine zuverlassige Schat- 
zung des Fahrspurverlaufs bzw. der Querlage von Objekten 
vor dem eigenen Fahrzeug bezogen auf die Fahrspur mog- 
lich ist, wobei die Genauigkeit irn allgemeinen merklich hd- 
her ist als bei einer blofien Anordnung beider Sensoriken 
ohne sensorfusionierende Schatzeinrichtung. 

Bei einer nach Anspruch 2 weitergebildeten Vorrichtung 
gehen die geometrischen Beziehungen zwischen den von 
der Fahrspurerkennungssensorik und der Objektpositions- 
sensorik erfafiten MeBgroBen als MeBgleichungen und de- 
ren dynamische Beziehungen als ZustandsgroBen-Differen- 
tialgleichungen in den Schatzalgorithmus ein. Dabei geht 
die Querposition eines jeweils vor dem Fahrzeug erkannten 
Objektes bezuglich der Fahrspur als zeitlich konstante Zu- 
standsgroBe in das Differentialgleichungssystem ein. Dieses 
Modell eignet sich besonders in Realisierungen, in denen 
die Objektpositionssensorik unmittelbar den Richtungswin- 
kel und den Abstand der Objekte und nicht nur diesbeziigli- 
che Rohdaten liefert, so daB die Zuordnung der Objekte zu 
den Objektzustanden und deren korrespondierenden MeB- 
gleichungen direkt gegeben ist Wenn dies nicht der Fall ist, 
ist eine Weiterbildung der Erfindung nach Anspruch 3 vor- 
teilhaft, bei der zusatzlich der Objektabstand und dessen 
Anderungsgeschwindigkeit als ZustandsgroBen in das Dif- 
ferentialgleichungssystem eingehen, wobei darin die Ab- 
standsanderungsgeschwindigkeit als zeitlich konstante 
GroBe behandelt wird. 

In weiterer Ausgestaltung der Erfindung nach Anspruch 4 
besteht die Schatzeinrichtung aus einem Kalman-Filter. 

Vorteilhafte Ausfuhrungsformen der Erfindung sind in 
den Zeichnungen dargestellt und werden nachfolgend be- 
schrieben. Hierbei zeigen: 

Fig. 1 eine schematische Darsteilung einer StraBenver- 
kehrssituation mit einem erfindungsgernaB ausgertisteten 
Personenkraftwagen und einem vorausfahrenden Personen- 
kraftwagen, 

Fig. 2 ein schematisches Blockdiagramm der im hinteren 
Personenkraftwagen von Fig. 1 implementierten Vorrich- 
tung zur Ermittlung fahrspurverlaufsindikativer Daten, 

Fig. 3 ein Diagramm zur Veranschaulichung von durch 
die Vorrichtung nach Fig. 2 ermittelten Fahrspurkrummun- 
gen und 

Fig. 4 ein Diagramm zur Veranschaulichung der durch die 
Vorrichtung nach Fig. 2 ermittelten Querposition des vor- 
ausfahrenden Fahrzeugs. 

Fig. 1 zeigt eine Verkehrssituation, bei der sich ein Perso- 


nenkraftwagen 1 mit einer Langsgeschwindigkeit v, einer 
Quergeschwindigkeit v Q und einer Giergeschwindigkeit ¥ 
auf einer Fahrspur 2 einer StraBe bewegt. Das Fahrzeug 1 ist 
mit einer Vorrichtung 3 zur Ermittlung fahrspurverlaufsindi- 
5 kativer Daten, insbesondere der Krummung der Fahrspur 2 
im Bereich vor dem Fahrzeug 1 sowie der beziiglich der 
Fahrspurmitte gemessenen Querposition xr eines jeweili- 
gen, vor dem Fahrzeug 1 befindlichen Objektes, wie des 
vorausfahrenden Personenkraftwagens 4, ausgeriistet. Diese 

10 Vorrichtung 3 beinhaltet zum einen eine herkommliche Ob- 
jektpositionssensorik auf Radarbasis, mit welcher derRich- 
tungswinkel <p zwischen der Richtung, unter der das vor 
dem Fahrzeug 1 befindliche Objekt 4 bezuglich der Langs- 
richtung des eigenen Fahrzeugs 1 erscheint, sowie der Ab- 

15 stand d und die Relativgeschwindigkeit v rc j des Objektes 4, 
nachfolgend als Radarobjekt bezeichnet, erfaBt werden. Mit 
Ay ist der relative Gierwinkel, d. h. der Winkel der Fahr- 
zcuglangsrichtung zur Fahrspurtangcntc bezeichnet. Die 
Fahrspurbreite ist mit b angegeben. Die Fahrspurkrummung 

20 ist mit c 0 und die Kriimmungsanderung mit c x bezeichnet 
Gut ausgebaute StraBen sind so ausgelegt, daB sich die Fahr- 
spiuicrummung c 0 annaherungsweise proportional mit der 
konstanten Rate ci andert, d. h. die Krummung co(L) im Ab- 
stand L ist gegeben durch cq(L) = c 0 (0) + CiL. Die Querpo- 

25 si lion des eigenen Fahrzeugs 1 bezuglich der Fahrspunnilte 
S ist mit x und diejenige des Radarobjektes mit x R bezeich- 
net. 

Die Vorrichtung 3 zur Ermittlung fahrspurverlaufsindika- 
tiver Daten beinhaltet des weiteren eine herkommliche 

30 Fahrzeugeigenbewegungssensorik, mit der die MeBgroBen 
des eigenen Fahrzeugs 1 erfaBt werden, wie Langsge- 
schwindigkeit v, Quergeschwindigkeit v Q und Gierge- 
schwindigkeit *H sowie eine herkommliche Fahrspurerken- 
nungssensorik in Form eines optischen Bildaufnahme- und 

35 Bildverarbeitssystems. Dieses System beinhaltet als bildauf- 
nehmendes Element eine Videokamera mit den Brennwei- 
tenparametern f x und f y in Langs- bzw. Querrichtung, wobei 
die Kamera auf einer Hohe H uber der Fahrbahn unter einem 
Nickwinkel a angeordnet ist. Wird zusatzlich ein Parameter 

40 a mit einem Wert von -0,5 fur die Markierung des linken 
Fahrspurrandes und einem Wert von +0,5 fur die Markie- 
rung des rechten Fahrspurrandes eingefuhrt, so gelten zwi- 
schen den Kamerabildkoordinaten x B , yB der Fahrspurrand- 
markierung in einer Entfemung L die Beziehungen 

45 

x B = f x (ab - x - AyL + cqL 2 /2 + c{]Jl6)IL und 
L = H(l - yBtana/f y )/(y B /f y + tana). 

50 Die unbekannten GroBen in der obigen Beziehung fur die 
Kamerabildkoordinate x B konnen mittels Parameterschatz- 
verfahren, wie z. B. der Methode der kleinsten Quadrate, be- 
stimmt werden, wenn eine ausreichende Anzahl von Bildko- 
ordinaten x B , y B verschiedener Fahrbahnmarkierungen 

55 durch die Bildverarbeitung ermittelt worden sind. Bessere 
Ergebnisse werden jedoch durch die Anwendung einer Be- 
obachter- bzw. Kalman-Filtertechnik erhalten, bei welcher 
fur die Schatzung die kinematischen Kopplungen und dyna- 
mischen Bedingungen der relevanten Parameter beriicksich- 

60 tigt werden. Dabei lassen sich durch das Schatzverfahren die 
Sensorinformationen aus der Fahrspurerkennungssensorik 
und der Objektpositionssensorik in verschiedenen Varianten 
unterschiedlich stark fusionieren, wobei auf die verschiede- 
nen Varianten unten naher eingegangen wird. Die Vorge- 

65 hensweisc basicrt jeweils darauf, daB zunachst die physika- 
lischen Zusammenhange bestimmt und dann in systemtheo- 
retischer Form mit einem linearen ProzeBmodell der Form 
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x = Ax +Bu 

sowie einer nichtlinearen MeBgleichung der Form 
y = h(x) 

dargestellt. werden, wie fiir Beobachter bzw. Kalman-Filter 
geiaufig, wobei x den ZustandsgroBenvektor, y den MeBgrd- 
Benvektor^ u und h(x) aus den fur das betreffende System 
geltenden Beziehungen zu ermittelnde Vektorfunktionen so- 
wie A und B zugehdrige Matrizen bezeichnen. Ein Ver- 
gleich mit. den obigen Beziehungen ergibt als Zustandsgro- 
Benvektor x = (x, A\|/, c 0 , c , , a, b) , als MeBgroBen vektor den 
einzeiiigen Vektor y = (x B ) und fur h die Beziehung h(x) = 
f x (ab - x - A\|/L + cqL 2 /2 + C!L 3 /6)L. Dabei sind von der 6 x 
6-Matrix A nur die Matrixelemente A n = -A 2 3 = A 34 = v 
und von der 2 x 2-Matrix B nur die Elemente B u = B22 = 1 
unglcich null, wahrcnd die ubrigen Matrixelemente null 
sind. Der Vektor u ergibt sich zu u = (v Q , 40 . 

Es versteht sich hierbei, daB jedes Paar von gemessenen 
Bildkoordinaten (x B? y B ) der Fahrspurmarkierungen eine 
MeBgleichungszeile der Form y = h(x) ergibt. 

Im Rahmen einer einfachen Fusion der Sensordaten laBt 
sich die Querposition x R eines Radarobjektes in der Entfer- 
nung d und unler dem Winkel cp durch die Beziehung 

x R = (pd + x + Ayd - Co d 2 /2 - Cid 3 /6 (Gl) 

annahern, wobei in diese Beziehung die Fahrspurdaten der 
Querposition x und des Richtungswinkels A\\f des eigenen 
Fahrzeugs 1 relativ zur Fahrspur sowie die Fahrspurkriim- 
mungsparameter cq und Ci eingehen. Vorzugsweise findet 
eine komplexere Fusion der Sensorausgangsdaten statt, wie 
naehfolgend naher erlautert. Fig. 2 zeigt eine auch fur eine 
solche komplexere Sensorfusionstechnik geeignete Vorrich- 
tung. 

Die \brrichtung von Fig. 2 beinhaltet die erforderliche 
Fahrspurerkennungs- und Objektpositions-Sensorikeinheit 
10, weiche die MeBwerte der MeBgroBen y liefert. Die Fahr- 
spurerkennungssensorik ist, wie gesagt, von einern Bildauf- 
nahme- und Bildverarbeitungssystem gebildet, kann jedoch 
altera ativ auch durch andere Einrichtungen mit fahrspurer- 
kennender Funktion realisiert sein, z. B. ein auf Induktions- 
schleifen oder magnetischen Nageln entlang der Fahrspur 
basierendes System oder ein auf dem sogenannten GPS 
(Global Positioning System) basierenden System zur ge- 
nauen Erfassung der Fahrzeugposition. Die Objektpositi- 
onssensorik ist im gezeigten Beispiel durch den Radarteil ei- 
nes Abstandsregeltempomaten (ART) realisiert, es kann je- 
doch zu diesem Zweck der Erkennung der Position von Ob- 
jekten vor dem Fahrzeug und insbesondere von vorausfah- 
renden Fahrzeugen auch ein anderes herkommliches System 
zum Einsatz kommen, welches den Abstand solcher Objekte 
und den Winkel erfaBt, unter dem die Objekte jeweils er- 
scheinen. Des weiteren weist die Vorrichtung eine Fahrzeu- 
geigenbewegungssensorik 11 auf, die unter anderem die 
Langs- und Quergeschwindigkeit v, vq des eigenen Fahr- 
zeugs und dessen Giergeschwindigkeit *F erfaBt. 

Als zentralen Bestandteil beinhaltet die Vorrichtung von 
Fig. 2 ein Kalman-Filter 12 ublichen Aufbaus mit einer Ver- 
starkungsstufe 13, einer Modellrechenstufe 14 und einer 
MeBgleichungsstufe 15. Am Ausgang der MeBgleichungs- 
stufe 15 wird der Schatz-MeBgroBenvektor y als Ausgangs- 
signal abgegeben, der in einem Subtrahierer 16 von den 
McBwcrtcn des McBgroBcnvcktors y subtrahicrt wird. Die 
daraus resultierende Differenz y - y wird einem Eingang der 
Verstarkungsstufe 13 zugefuhrt, der an einem zweiten Ein- 
gang das Ausgangssignal der Fahrzeugeigenbewegungssen- 


sorik 11 zugefuhrt wird. Das Ausgangssignal der Fahrzeu- 
geigenbewegungssensorik 11 wird parallel dazu einem Ein- 
gang der Modellrechenstufe 14 zugefuhrt, welcher an einem 
zweiten Eingang das Ausgangssignal der Verstarkungsstufe 
5 13 zugefuhrt wird. Das Ausgangssignal der Modellrechen- 
stufe 14 wird der MeBgleichungsstufe 15 zugefuhrt, die dar- 
aus den Schatz-MeBgroBenvektor y generiert. Durch die 
Verkniipfung, d. h. Fusion, der Ausgangssignale der Objekt- 
positionssensorik und der Fahrspurerkennungssensorik init- 
io tels dieser Kalman-Filtertechnik macht es moglich, gleich- 
zeitig sowohl die Fahrspurerkennung als auch die Spurzu- 
ordnung der Radarobjekte zu verbessern. 

In einer ersten weiterentwickelten Variante der oben er- 
lauterten einfachen Sensorfusion werden die Daten der Ob- 
15 jektpositionssensorik, d. h. des Radars, zwecks Verbesse- 
rung der Spurschatzung dahingehend verwendet, daB die 
nicht direkt meBbare Querposition x R eines jeweiligen Ra- 
darobjektes als cine ZustandsgroBc in den Schatzalgorith- 
mus eingefuhrt wird. Als Modell fur diese Querposition x R 
20 wird angenommen, daB Radarobjekte, auch vorausfahrende 
Fahrzeuge, im zeitlichen Mittel ihre Lage bezuglich der 
Fahrspur beibehalten, so daB die Zustandsdifrerentialglei- 
chungen fur jedes Radarobjekt um die Gleichung x R = 0 er- 
weitert werden. AuBerdem wird die sich aus der obigen Be- 
25 ziehung fur die Querposition xr eines jeweiligen Radarob- 
jektes ergebende Beziehung 

<() = -x7d - Ay + cod/2 + C!d 2 /6 + x R /d 

30 fur den Radarobjekt-Richtungswinkel <p als eine zusatzliche 
MeBgleichung genutzt. Tatsachlich gemessen werden vom 
Abstandsradar der Abstand d, die Relativgeschwindigkeit 
v re l und der Rich tungs winkel (p. Fiir jedes Radarobjekt er- 
weitern sich somit der ZustandsgroBenvektor x um die je- 

35 weilige Querposition x R des betreffenden Radarobjektes, 
wahrend der Vektor u unverandert bleibt und die Matrizen A 
und B nur um weitere Matrixelemente mit dem Wert null er- 
weitert werden. Zudem erweitert sich die systemtheoreti- 
sche MeBgleichung pro Radarobjekt um je eine weitere 

40 Zeile der Form y = <p mit h(x) = -x/d - A\\f + Cod/2 + Cid 2 /6 + 
x R /d. 

Dabei wurde der Ubersiehtlichkeit halber von der Einfuh- 
rung weiterer Indizes fur das jeweilige Radarobjekt abgese- 
hen. Die damit realisierte Vorrichtung ist zur Ermittlung des 

45 Fahrspurverlaufs vor dem eigenen Fahrzeug und der Quer- 
position von dort detektierten Objekten unter Nutzung des 
Schatzalgorithmus mittels Kalman-Filter besonders fur die- 
jenigen Anwendungsfalle geeignet, in denen vom Abstands- 
radar der Abstand d und der Richtungswinkel <p zu jedem 

50 Radarobjekt geliefert werden, so daB die Zuordnung zu den 
Radarobjekt-Zustanden, d. h. insbesondere zu deren Quer- 
position x R relativ zur Fahrspur, und zu deren korrespondie- 
renden MeBgleichungen direkt gegeben ist. In realen Syste- 
men liefert das Abstandsradar jedoch zunachst nur Radar- 

55 rohziele, d. h. Satze zusammengehoriger Messungen des 
Abstands d, der Relativgeschwindigkeit v^i und des Rich- 
tungswinkels <p, aus denen dann erst die Radarobjekte als 
gespeicherte Objekte durch Zielverfolgung von Radarroh- 
zielen, d. h. durch Zuordnung aktueller Messungen zu ge- 

60 speicherten Objekten, die ihrerseits friiheren, gefilterten 
Messungen entsprechen, erzeugt werden. 

In diesem Fall kann die Vorrichtung von Fig. 2 in einer 
noch weiter entwickelten Variante so ausgelegt sein, daB die 
Radarobjekte im Sensorfusionssystem selbst erzeugt wer- 

65 den. Dazu wird dann der Schatzalgorithmus im Kalman-Fil- 
ter 12 wie folgt erweitert Pro Radarobjekt werden zusatz- 
lich der Abstand d R und die Relativgeschwindigkeit v re iR als 
ZustandsgroBen eingefuhrt, fur weiche die kinematischen 
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Zustandsdifferentialgleichungen 

dR = v relR und v relR = 0 

angesetzt werden. Die Zustande d R und v rctR werden direkt 5 
gemessen, so daB der geometrische Zusammenhang zwi- 
schen diesen ZustandsgroBen d R , v^r und den MeBgrdBen 
d, v rc i durch d = d R bzw. v rcl = v rclR gegeben ist. Pro Radar- 
objekt erweitert sich somit der ZustandsgroBen vektor x urn 
den dreizeiligen Vektor (x R , d R , v re i R ) T , wobei wiederum der 10 
Ubersichtlichkeit halber ein weiterer Index zur Unterschei- 
dung der verschiedenen Radarobjekte weggelassen ist. Au- 
Berdem erweitert sich dementsprechend die Matrix A in der 
Hauptdiagonalen um eine 3 x 3-Malrix, bei der nur das Ele- 
ment der zweiten Zeile und dritten Spalte den Wert eins hat, 15 
wahrend die ubrigen Matrixelemente null sind. Der Vektor u 
bleibt unverandert. Die systemtheoretische MeBgleichung 
erweitert sich hingegen pro Radarobjekt um den Zusatz- 
MeBgroBen vektor y t - (<p, d, v^i) 7 und um drei entspre- 
chende zusatzliche Zeilen 20 

h z (x) = (-x/d R - A\jf + Cod R /2 + c L d R 2 /6 + x R /d R , d R , v^ 7 

zu der Funktion h(x). Die Zielverfolgung kann z. B . dadurch 
realisiert werden, daB die Radarrohziele mil Hilfe eines 3a- 25 
Tests fur die drei MeBgroBen <p, d und v rc i des Abstandsra- 
dars den Radarobjekten zugeordnet werden. Ein solcher 3a- 
Test ist beispielsweise in der Dissertation von B. Mysliwetz, 
Parallelrechnerbasierte Bildfolgen-Interpretation zur auto- 
nomen Fahrzeugsteuerung, Universitat der Bundeswehr 30 
Miinchen, 1990 beschrieben. Bei Bedarf kann fiir den Filter- 
entwurf ein erweitertes Kalman-Filter Verwendung finden, 
bei dem additiv zum Zustandsdifferentialgleichungssystem 
stochastisches ProzeBrauschen und zum MeBgleichungssy- 
stem stochastisches MeBrauschen hinzuaddiert werden. Zur 35 
weiteren Behandlung, einschlieBlich Diskretisierung und 
Faktorisierung, eines solchen erweiterten kontinuierlichen 
Kalman-Filters kann auf die Literatur verwiesen werden, 
siehe z. B. V Krebs, Nichtlineare Filterung, R. Oldenburg 
Verlag, Miinchen, 1980 und Bieruran, Factorization Me- 40 
thods for Discrete Sequential Estimation, Academic Press, 
New York, 1977. 

Im Diagramm von Fig. 3 sind Resultate bezuglich der 
Schatzung des Fahrspurverlaufs, speziell uber den Wert der 
geschatzt ermitteken Spurkriimmung cq in Abhangigkeit 45 
von der Zeit t wahrend eines beispielhaften Fahrabschnitts 
dargestellt Dabei werden die Resultate gemaB der oben er- 
wahnten einfachen Sensorfusion mit den Resultaten der zu- 
letzt beschriebenen Systemauslegung mit einer Sensorfu- 
sion mit drei Zustanden pro Radarobjekt im Kalman-Filter 50 
verglichen. In Fallen guter Sichtweite von beispielsweise 
mehr als etwa 60 m sind die Ergebnisse fiir beide System- 
auslegungen naherungsweise gleich und durch die gemein- 
same, durchgezogen gezeichnete Kennlinie Kl veranschau- 
iicht, die foiglich als Referenz fur den Fall schlechter Sicht- 55 
weite dienen kann. Zum Vergleich wurde derselbe Fahrspur- 
abschnitt nochmals fur den Fall einer schlechten Sichtweite 
von nur etwa 20 m durchfahren. Die gestrichelte Kennlinie 
K2 zeigt dann das Ergebnis der einfachen Sensorfunktion 
ohne Verwendung der Abstandsradardaten zur Verbesserung 60 
der Spurschatzung, wahrend die gepunktet dargestellte 
Kennlinie K3 das Resultat des komplexen Sensorfusionssy- 
stems mit drei Zustanden pro Radarobjekt fiir die Zustands- 
schatzung wiedergibL An den Werten fur c 0 ist ablesbar, daB 
der befahrcne Fahrspurabschnitt zunachst in den crstcn 20 65 
Sekunden eine Linkskurve war, die dann in eine Rechts- 
kurve uberging. 

Aus Fig. 3 ist des weiteren ersichtlich, daB bei schlechter 
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Sichtweite die Schatzung der Fahrspurkrummung cq durch 
das System mit komplexerer Sensorfusion dem Referenz- 
verlauf gemaB der Kennlinie Kl deutlich naher kommt als 
das Ergebnis der rein optischen Spurerkennung mit nur ein- 
facher Sensorfusion gemaB der Kennlinie K2. AuBerdern ist 
ein Voreilen der vom System mit komplexerer Sensorfusion 
bei schlechter Sichtweite geschatzten Spurkriimmung ge- 
genuber der von den beiden betrachteten Systemen bei guter 
Sichtweite geschatzten Spurkriimmung beim Ubergang von 
der Links- in die Rechtskurve zu beobachten. Dies kann als 
VergroBerung der Sichtweite mit Hilfe des oder der detek- 
tierten Radarobjekte interpretiert werden. Bei guter Sicht- 
weite tritt dieser Voreil-Effekt deshalb nicht so stark in Er- 
scheinung, weil es dann mehr MeBpunkte aus der optischen 
Fahrspurerkennungssensorik gibt und die Messung des Ra- 
darobjekts somit nicht so stark ins Gewicht fallt. 

Im Diagramm von Fig. 4 sind Ergebnisse der beiden zu 
Fig. 3 betrachteten Systcmauslcgungcn bezuglich der Er- 
mittlung der Querposition x R eines vorausfahrenden, detek- 
tierten Radarobjektes, d. h. speziell eines vorausfahrenden 
Fahrzeuges, mitteis Schatzung veranschaulicht. Dabei vari- 
ierte der Abstand dieses Objektes zum eigenen Fahrzeug 
zwischen etwa 85 m und 115 m. Die punktiert gezeichnete, 
starker verrauschte Kennlinie K4 steilt das Resultat fiir die 
geschatzte Querposition xr in Abhangigkeit von der Zeit t 
fur den beispielhaften Fahrabschnitt bei schlechter Sicht- 
weite dar, wie es von dem System mit einfacher Sensorfu- 
sion erhalten wird, indem die Radarobjekt-Querposition x R 
unter Verwendung ungefilterter Abstandsradarmessungen 
anhand der obigeh Naherungsgleichung Gl fur x R berechnet 
wird. Die durchgezogene, glattere Kennlinie K5 zeigt hinge- 
gen fiir dieselbe Fahrsituation das Ergebnis der Schatzung 
der Radarobjekt-Querposition xr durch das System mit 
komplexerer Sensorfusion, bei welchem diese Querposition 
x R neben dem Radarobjektabstand dR und der Objektrelativ- 
geschwindigkeit v re iR als ZustandsgroBe in das Kalman-Fil- 
ter eingeht 

Wahrend fiir den nicht dargestellten Fall guter Sichtweite 
durch eine TiefpaBfilterung der verrauschteren Kennlinie 
des Systems mit einfacher Sensorfusion ahnliche Ergebnisse 
erhalten werden wie durch das System mit komplexerer 
Sensorfusion, ergibt sich bei schlechter Sichtweite, daB in 
dieser Situation nur das System mit komplexerer Sensorfu- 
sion noch ein Resultat fur die geschatzt ermittelte Radarob- 
jekt-Querposition x R ahnlich demjenigen bei guter Sicht- 
weite liefert. Das System mit einfacher Sensorfunktion lie- 
fert hingegen bei dieser schlechten Sichtweite ein da von si- 
gnifikant unterschiedliches Ergebnis. Denn selbst eine Tief- 
paBfilterung der Kennlinie K4 ergibt einen noch immer 
deutlich von demjenigen der Kennlinie K5 verschiedenen 
Verlauf. 

Daraus folgt, daB die komplexere Sensorfusion mit Kal- 
man-Filter vor alien! bei schlechter Sichtweite deutlich bes- 
sere Schatzergebnisse auch fiir die Querposition x R von vor 
dem Fahrzeug berindlichen Objekten liefert als eine einfa- 
che Verknupfung von Spurerkennung und Abstandsradar. 
Im Gegensatz zur einfachen Verknupfung von optischer 
Spurerkennung und Abstandsradar erlaubt es somit die Sen- 
sorfusion mit Kalman-Filter, die Spurablage, d. h. die Quer- 
position, vorausfahrender Fahrzeuge und anderer Objekte 
vor dem Fahrzeug auch bei schlechter Sichtweite sehr zu- 
verlassig zu berechnen. Je nach Systemauslegung kann da- 
bei fur die Sensorfusion eine Vorverarbeitung bzw. Zielver- 
folgung anhand der Radardaten vorausgesetzt werden oder 
cs konncn rohc Radardaten im Kalman-Filter vcrarbcitct 
werden. In letzterem Fall liefert die erfindungsgemaBe Vor- 
richtung neben den Fahrspurdaten auch im Sinne minimaler 
Varianz optimal gefilterte Radarobjekte. 


30 
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Die erfindungsgemaBe Vorrichtung ermoglicht die Er- 
mittlung fahrspurverlaufsindikativer Daten in Form der ge- 
schatzten Fahrbahnkrummung Cq und/oder der Querposition 
x R eines jeweiligen Objektes vor dem eigenen Fahrzeug in 
Echtzeit auch mit den in Fahrzeugen naturgemafi begrenzten 5 
Rechenkapazitaten. Es versteht sich, daB neben den be- 
schriebenen weitere Realisierungen der erfindungsgemaBen 
Vorrichtung moglich sind. So kann eine noch komplexere 
Systemauslegung zur weiteren Verbesserung der Spurschat- 
zung vorgesehen werden, bei welcher zur genaueren Mes- 10 
sung des Richtungswinkels <p eines jeweiligen Radarobjek- 
tes mit Hilfe des Abstandsradars die ungefahre Objektposi- 
tion bestimmt und diese dann mittels eines Bildaufnahme- 
und Bildverarbeitungssy stems mit hoherer Genauigkeit er- 
mittelt wird. Fur die Bildverarbeitung kann ein einf aches 15 
Objekterkennungsverfahren eingesetzt werden, das z. B. 
aucn die Symmetrie von Objekten, wie Fahrzeugen, aus- 
nutzu sichc z. B. hicrzu A. Kiihnlc, Symmetry-based reco- 
gnition of vehicle rears, Pattern Recognition Letters 12, 
April 1991, Seite 249. Des weiteren kann anstelle des Ab- 20 
standsradarsy stems eine andere Objektpositionssensorik 
verwendet werden, z. B. bei Vorhandensein einer ausrei- 
chenden Rechenieistung ein Stereobildaufbahme- und Ste- 
reobildverarbeitungssystem. Die in diesem Fall nicht rnehr 
direkt ineBbare Relalivgeschwindigkeit kann dann als Zu- 25 
stand im Kalman-Filter beobachtet werden. 

Eine weitere Moglichkeit der Fahrspurerkennung besteht 
in der Verwendung eines GPS und einer geeigneten digita- 
len Wegenetzkarte. Damit konnen die eigene Position sowie 
Koordinaten der aktuellen Fahrspur in einer Entfemung 30 
L G ps ermittelt werden, und das MeBgleichungssystem laBt 
sich um die Zeile 

*GPS = x 

+ A\|fL G ps + coL 2 GPS /2 + ciL 3 GPS /6 

35 

erweitern. 

Die erfindungsgemaBe Vorrichtung kann aufgrund ihrer 
Eigenschaft, eine zuverlassige Schatzung des Fahrspurver- 
laufs durch Berucksichtigung stehender und/oder fahrender 
Objekte in einem geschlossenen Schatzalgorithmus zu lie- 40 
fern, unterstutzend in Systemen zur automatischen Quer- 
und/oder Langsfuhrung von Kraftfahrzeugen und in Warn- 
systemen, z. B. in einem Auffahrwarnsystem, eingesetzt 
werden. 

45 

Patentanspriiche 

1. Vorrichtung zur Ermittlung von filr den Verlauf ei- 
ner Fahrspur indikativen Daten, mit 

- einer Fahrspurerkennung ssensorik (10) welche 50 
FahrspurerkennungsmeBdaten liefert, 

- einer Objektpositionssensorik (10), welche we- 
nigstens den Abstand (d) eines vor dem Fahrzeug 
befindlichen Objektes (4) und dessen Richtungs- 
winkel (<p) beziiglich der Fahrzeug bewegungs- 55 
richtung erfaBt, und 

- einer Fahrzeugeigenbewegungssensorik (11) 
zur Erfassung der Fahrzeugeigenbewegung, 

gekennzeichnet durch 

- eine Schatzeinrichtung (12), der die Fahrspur- 60 
erkennungsmeBdaten von der Fahrspurerken- 
nungssensorik (10) und die ObjektpositionsmeB- 
daten von der Objektpositionssensorik (10) sowie 
die FahrzeugeigenbewegungsmeBdaten von der 
Fahrzeugeigenbewegungssensorik (11) zugcfuhrt 65 
werden und die in Abhangigkeit von diesen MeB- 
daten die Fahrspurkriimmung (cq) und/oder die 
Querposition (xr) eines jeweiligen, von der Ob- 
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jektpositionssensorik detektierten Objektes relativ 
zur Fahrspur (2) durch Schatzung mittels eines 
vorgebbaren, ein dynamisches Fahrzeugbewe- 
gungsmodell beinhalrenden Schaty.a1gorithmus 
ermittelt. 

2. Vorrichtung nach Anspruch 1, weiter dadurch ge- 
kennzeichnet, daB die geometrischen Beziehungen 
zwischen den von der Fahrspurerkennungssensorik 
und der Objektpositionssensorik erfaBten MeBgroBen 
als MeBgleichungen und deren dynamische Beziehun- 
gen als ZustandsgroBendifferentialgleichungen in den 
Schatzalgorithmus eingehen, wobei die Querposition 
(x R ) eines jeweiligen Objektes als zeitlich konstante 
ZustandsgroBe in den Differentialgleichungen behan- 
delt wird. 

3. Vorrichtung nach Anspruch 2, weiter dadurch ge- 
kennzeichnet, daB der Abstand (d R ) und die Abstands- 
andcrungsgcschwindigkcit (v relK ) als weitere Zustands- 
groBen in den Schatzalgorithmus eingehen, wobei die 
Abstandsanderungsgeschwindigkeit als zeitlich kon- 
stante ZustandsgroBe behandelt wird. 

4. Vorrichtung nach einem der Anspriiche 1 bis 3, wei- 
ter dadurch gekennzeichnet, daB die Schatzeinrichtung 
ein Kalman-Filter (12) ist. 
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